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FAST POSITIONING OF DISK DRIVES AND OTHER 
PHYSICAL SYSTEMS 
Related Applications 

The present application is based upon co-pending U.S. provisional patent 
5 application Serial No. 60/428,896, filed November 22, 2002, the benefit of the 
filing date of which is claimed under 35 U.S. C. § 1 19(e). 

Government Rights 
The present invention was developed with funding provided under 
National Science Foundation Contract No. CMS 0196214, and National 
10 Aeronautics and Space Administration Contract No. NAG 2-1450, and the federal 
government may therefore have rights in the present invention. 

Field of the Invention 
The present invention pertains to a method for precise, fast positioning of 
a physical component, and more specifically, to a method for precise, fast 
15 positioning of read/write heads in disk drives and other such components using an 
actuating force applied to the component during and outside a time interval during 
which the component is actually moved from an initial position to a different 
desired position. 

Background of the Invention 

20 A fundamental control problem is determining a suitable input signal to 

drive a physical component from a first position (at time ti) to a second position 
(at time tj) during an output-transition time interval, U - tf. This problem arises in 
controlling a driver for almost any form of physical component that is rapidly 
positioned. In many such control applications, the controlled component must be 

25 precisely positioned both at a first position, before the output-transition time 
interval, and at a second position, after the output-transition time interval. 
Performing fast maneuvers with flexible structures can introduce severe vibration 
problems, resulting in loss of positioning precision after the completion of an 
output transition and inefficiency in the positioning process. For example, when 
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positioning a read/write head of a disk drive, read or write operations cannot be 
performed before or after an output transition that moves the head, if the output 
position is not precisely maintained at the desired track. Residual vibrations 
arising due to the elastic flexibility of the head support structure may require a 
5 prohibitively long time to settle out, increasing the working cycle time, since the 
read/write head cannot perform a next task until the vibrations are reduced to an 
acceptable level. Accordingly, it is very important in such control applications to 
achieve output transitions without residual vibrations. 

As opposed to the problem of changing the output-point on a flexible 

10 structure, the problem of changing the complete configuration, i.e., the state of 
system such as a flexible structure, has been well studied in prior literature. These 
techniques, which solve the state-to-state transition problem (sometimes referred 
to as the state-transition problem), can also be used to find a solution to the 
output-transition problem. In particular, output transitions without residual 

1 5 vibrations can be obtained by requiring that the flexible system maneuver between 
equilibrium configurations (rigid-body rest configurations). These rest states are 
chosen to achieve initial and final output values at the beginning and end of the 
output transition. Once the boundary states at the beginning and end of output 
transition are chosen to be the rest states, then a solution to the output-transition 

20 problem can be found by solving the standard, optimal (e.g., minimum-energy), 
state-transition problem from the initial state to the final state, which is referred to 
as the "rest-to-rest state-transition approach." However, the solution found with 
this choice of the boundary states may not lead to an optimal output-transition. On 
the other hand, arbitrary choices of the boundary states are also not acceptable, 

25 because they may not allow the output to be maintained at a constant value after 
the completion of the output-transition, i.e., without residual vibrations, for any 
choice of the input. Therefore, standard optimal state-to-state transition 
approaches cannot be used to directly solve the optimal output-transition problem. 
Clearly, a better approach is needed that permits the input required to 

30 achieve an optimal output transition. In addition to enabling a minimum input 
energy to be achieved, it would also be desirable to enable other optimal criteria, 
such as achieving a minimum time for a transition, to be applied in determining 
the input needed to achieve the desired goal. 
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Summary of the Invention 

One aspect of the present invention is directed to a method for controlling 
an element that is part of a system so that when it is necessary to reposition the 
element, the element is moved between a first position and a second position 
5 during a transition-time interval. More importantly, the element is controlled so 
that it only moves during the transition-time interval and is precisely positioned 
both immediately before and after the transition-time interval. Also, more than 
one element can be moved in accord with these constraints using the present 
invention. The proposed invention can thus be applied to control multiple 

10 elements, provided there are multiple inputs in the system. The method uses a 
model of the system that includes the element to determine the appropriate control 
input signal. The model will encompass the nature of the system and the movable 
element, and the manner in which the element is to be moved. Using the model, 
the method characterizes the internal dynamics of the system in which energy 

15 applied to the system outside the transition-time interval is hidden, so that the 
element does not move other than during the transition-time interval. For a 
selected optimization criterion, optimal internal states are then determined at a 
beginning and an end of the transition-time interval in which movement of the 
element between the first position and the second position is to occur. Based 

20 upon the optimal internal states, an optimal control input signal is determined for 
at least one of a pre-actuation input, a post-actuation input, and a transition- 
interval input acting on the system. A pre-actuation input applies energy to the 
system before the transition-time interval, and a post-actuation input applies 
energy to the system after the transition-time interval. A transition-interval input 

25 applies energy to the system during the transition-time interval. The optimal 
control input signal is determined so as to cause the element to move from the 
first position to the second position and to achieve the selected optimization 
criterion. 

The optimization criterion can be selected to achieve different goals. For 
30 example, the goal may include, but is not limited to, moving one or more elements 
between a first position and a second position with substantially a minimum input 
energy, or in substantially a minimum transition-time interval, or to achieve a 
combination of these goals. 

The pre-actuation input is uniquely specified in terms of an unstable 
35 internal state component. In contrast, the post-actuation input is uniquely 
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specified in terms of a stable internal state component. The unstable internal state 
component and the stable internal state component are the only components of the 
boundary states for the first position and the second position that can be varied to 
ensure that the element does not move as a result of the energy applied to the 
5 system other than during the transition-time. 

In a preferred embodiment, the control input signal is defined as a function 
of a transition state difference related to the difference between the first position 
and the second position. 

The pre-actuation input, the post-actuation input, and the transition- 

10 interval input each comprises a signal with periodically varying components at 
one or more frequencies selected to act on the element without causing the 
element to move prior to or after the transition-time interval. 

In one embodiment, the method includes the step of applying an input 
signal (the transition-interval input) to move the element during the transition- 

1 5 time interval, as well as the post-actuation input after the transition-time interval. 
In this embodiment, a pre-actuation input is not employed. Similarly, in another 
embodiment, an input signal is applied to move the element during the transition- 
time interval, as well as the pre-actuation input before the transition-time interval; 
however, a post-actuation input is not employed. 

20 One preferred application of the present invention is used to control a 

read/write head of a nonvolatile memory device so that the head is moved 
between the first position and the second position to provide access to different 
portions of a memory medium. Depending upon the application, the element may 
comprise part of a nonlinear system. As noted above, multiple elements can also 

25 be moved in accord with the present invention, provided that multiple inputs are 
employed in the system. 

The element may be moved between the first position and the second 
position to carry out different functions. For example, depending upon the nature 
of the element, it may be moved for scanning a surface, reading data, writing data, 

30 positioning the element to implement a process, positioning the element to access 
a desired material, controlling a process, fabricating a component, or controlling 
the operation of a system in which the element is included. 

Another aspect of the present invention is directed to a memory medium 
on which machine readable instructions are stored for carrying out steps that are 

35 generally consistent with the steps of the method described above. Yet another 
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aspect of the present invention is directed to a controller for moving an element 
that is part of a system, during a transition-time interval, to achieve a selected 
optimization criterion. The controller includes a memory that stores machine 
instructions, and a processor that is coupled to the memory and executes the 
5 machine instructions to implement functions that are generally consistent with the 
steps of the method discussed above. 

Finally, another aspect of the present invention is directed to a method for 
moving an element that is part of a system, between a first position and a second 
position, during a transition-time interval, to achieve at least one of a minimum 
10 transition-time interval and a minimum energy for moving the element. The 
method starts by determining a relative degree of the system. Next, an inverse 
input for the system is determined. A transformation matrix is then selected to 
convert system equations that define the system, into an output tracking form, and 
the system equations are transformed into the output tracking form. Internal 
15 dynamics of the system are decoupled, producing decoupled internal dynamics, 
for which parameters are computed. Finally, an optimal output-transition solution 
is determined as a function of the parameters so that an optimal control input is 
defined for adding at least one of a pre-actuation energy and a post-actuation 
energy to the element without causing movement of the element other than during 
20 the transition-time interval. 

Brief Description of the Drawing Figures 
The foregoing aspects and many of the attendant advantages of this 
invention will become more readily appreciated as the same becomes better 
understood by reference to the following detailed description, when taken in 
25 conjunction with the accompanying drawings, wherein: 

FIGURE 1 is a schematic block diagram of a controller for controlling a 
movable component in accord with the present invention; 

FIGURE 2 is a schematic block diagram of an exemplary application of 
the present invention showing a rotating data disk and a read/write head that is 
30 controlled using pre- and/or post-actuation in accord with the present invention; 

FIGURE 3 is a graph showing the position of the read-write head of 
FIGURE 2 as a function of time, when the position of the read/write head is 
controlled by the controller of FIGURE 1; 

FIGURE 4 is a functional block diagram illustrating the control scheme 
35 implemented by the controller in positioning the read/write head; 
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FIGURE 5 is a flow chart illustrating the overall steps employed in the 
present invention; 

FIGURE 6 is a graph showing a continuous input signal applied to the 
motor used to position the read/write head, where the continuous input signal is 
5 determined in accord with the present invention using an optimal output-transition 
approach, u oot (t); 

FIGURE 7 is a graph showing the output position of the read/write head as 
a function of time (optimal output trajectory, y oo t(0) * n response to the continuous 
input signal of FIGURE 6; 
10 FIGURE 8 is a graph showing a discrete input signal applied to the motor 

used to position the read/write head, where the discrete input signal is determined 
in accord with the present invention using an optimal output-transition approach, 
u oot (t); and 

FIGURE 9 is a graph showing the output position of the read/write head as 

15 a function of time (optimal output trajectory, y 00 t(t)) in response to the discrete 
input signal of FIGURE 8. 

Description of the Preferred Embodiment 
Exemplary Applications of the Present Inventions 

The present invention is generally applicable to controlling the movement 

20 of almost any physical element that is moved from one position to another. The 
size of the physical element can range from the nano-scale to the macro-scale. 
Thus, the present invention can be employed in many different applications and 
for many different purposes. Detailed examples are provided below showing how 
the present invention is used for controlling the movement of a read/write head of 

25 a disk drive using both a continuously varying control signal and one that varies in 
discrete steps. Other exemplary applications of the invention include: positioning 
silicon wafers during semi-conductor manufacturing; positioning tools during 
manufacturing and fabrication operations such as drilling and spot welding; 
positioning land-based or space-based antennae; fast scanning (to achieve a 

30 trajectory employed for repetitively returning a scan head to a reset position 
before repeating a scan along a desired trajectory) for use in graphic scanners, 
retinal scanners, etc.; designing optimal reset trajectories for cams (i.e., for 
mechanical cams used in engines and other devices); design of quick return 
mechanisms used in machines such as shapers and planers that implement 

35 to-and-fro movement of a component; positioning sensor probes over a sample 
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such as biological cells being probed, for example, by an atomic force microscope 
or a scanning tunneling microscope; design of output transition trajectories for 
chemical reactors, such as continuously stirred tank reactors, so as to minimize 
waste; and design of trajectories for changing operating conditions of a system, 
5 such as changing the lift of an aircraft from helicopter mode to aircraft mode (e.g., 
in an aircraft such as the OSPREY). 

Each of the exemplary applications of the present invention noted above 
has requirements and parameters that are specific to that application. 
Accordingly, it will be important to accurately model the system in which the 

10 present invention will be employed for controlling the movement of a system 
element. Some applications will require non-linear models to obtain the input 
signal for controlling movement of the element, while others will use a linear 
model to obtain the input signal. In certain applications, the control input signal 
to move the element will be continuous, while in others, it will be a series of 

15 discrete input pulses. The present invention is useful in each of these applications 
and is readily adapted to meet almost any requirements. By properly modeling 
the system, it will generally be possible to adapt the present invention to a given 
application in which efficient movement of an element between positions is 
desired. 

20 In addition to being useful in a number of very different applications, the 

present invention enables a user to select a desired optimization criterion. For 
example, in certain cases, it may be desirable to optimize the energy input to a 
system to move an element from a first position to a second position. In other 
instances, the optimization criteria may be moving the element from a first 

25 position to a second position in a minimum time. It may also sometimes be 
desired to optimize both the input energy and the time required to move an 
element between two positions. These and other optimization criteria can be 
selected by the user when implementing the present invention to determine the 
input that will achieve the desired goal. 

30 In a conventional control, energy is typically only applied to move an 

element during the time at which movement of the element is desired, i.e., 
between times U and tp An important aspect of the present invention is that it 
achieves the desired optimization criteria by applying a pre-actuation input and/or 
a post-actuation input to the element respectively before and after the transition- 

35 time interval in which the element is expected to move between a first position 



UNIV0189-l-2l/0189AP.doc 



SCV #2838-3676 



-8- 



and a second position. However, the energy applied before or after the transition- 
time interval is "hidden" in the system and does not cause the element to move 
other than during the transition-time interval. Of course, energy will typically 
also be applied by the transition-interval input during the transition-time interval 
5 to move the element. The energy applied as a pre- and/or post-actuation input 
assists the element in more efficiently moving between the two positions, but the 
element is stable, and no movement of it occurs except during the transition-time 
interval. In a system that employs repetitive movement of an element, the 
movement of the element will only occur during repetitive transition-time 
10 intervals; during the remaining time the element will follow a predefined desired 
output trajectory. 

If a pre-actuation input is used, advance knowledge that the element will 
need to be moved during the transition-time interval is required. In any 
application of the present invention in which advance knowledge of the 

15 movement between two positions cannot occur, the present invention will only 
apply energy to move the element during the transition-time interval and as a 
post-actuation input. In other cases, it may be necessary to only apply the 
pre-actuation input as well as the energy to move the element during the 
transition-time interval, but not the post-actuation input. These different 

20 conditions can readily be met by the present invention and will typically be 
identified in the model of the system that is used in determining the pre- and/or 
post-actuation inputs as required. 
Controller for Implementing the Present Invention 

Although the present invention is readily implemented on a personal 

25 computer or other computing device, a general controller 10 for implementing the 
present invention is illustrated in FIGURE 1. Controller 10 includes a 
processor 12 that executes a plurality of machine instructions stored in a 
memory 14. Optionally, a nonvolatile storage 22 such as a hard drive can be used 
for storing the machine instructions. These software instructions comprise a 

30 software program having one or more modules, libraries, and/or other software 
components. To implement control of a system in accord with the present 
invention, the machine instructions comprising the software for determining the 
pre- and/or post- actuation input is loaded into memory 14 from storage 22, or 
alternatively if nonvolatile storage 22 is not provided, is simply accessed in 

35 memory 14 for execution by the processor. While not required in many cases, a 
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user input/output interface 16 may be provided for input of text, or control of this 
and other programs being executed by processor 12. Upon executing the machine 
instructions, processor 12 produces a signal that includes either or both of a 
pre-actuation input and a post-actuation input, as well as the input signal applied 
5 during the transition-time interval that will cause a driver 18 to reposition a 
movable component 20 along a desired trajectory during the transition-time 
interval. In the following examples, the element is moved between a first position 
and a second position. Although not required, a feedback sensor 24 may be 
included to provide a feedback signal indicative of the current actual position of 

10 the movable element for comparison to a desired position of the element. If used, 
feedback sensor 24 provides a feedback signal that is input to processor 12 and 
employed by it for determining any error that may exist between a desired 
trajectory or position for the movable element and its actual position. 

Further details relating to determining the input signal for controlling a 

1 5 movable element to cause the element to move are discussed below in connection 
with an exemplary preferred embodiment employed for moving a read/write head 
of a hard disk drive between two positions. 

FIGURE 2 schematically illustrates how the present invention is used to 
control a read/write head 34 of a hard disk. The read/write head is affixed to 

20 distal end of the movable arm 40 that is actuated by a motor 42 under control of 
an input signal provided by a read/write head position controller 44. Read/write 
head position controller 44 includes at least processor 12 and memory 14 of 
controller 10. Read/write head 34 is shown initially at a position 1 where it can 
be used to read or write to a track 36 on the memory medium provided on a 

25 rotating data disk 32. When it is necessary to move to a track 38 corresponding 
to a position 2, read/write head position controller 44 produces a control signal 
with pre- and post-actuation inputs, causing motor 42 to efficiently move 
read/write head 34 from position 1 to position 2. An optional feedback signal 
provides an indication of any difference or error between the desired trajectory 

30 of read/write head 34 as it moves from position 1 to position 2, and its actual 
trajectory. 

As indicated by a horizontal line 50 in FIGURE 3, read/write head 34 is 
precisely positioned at position 1 prior to a transition-time interval. Similarly, 
once the read/write head has reached position 2, it is precisely positioned and does 
35 not move, as indicated by a horizontal line 52. Thus, the read/write head does not 
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move prior to a time 7} or after a time 7/, which define the beginning and end of 
the transition-time interval. Prior to moving from position 1, a pre-actuation input 
is applied to motor 42 but does not cause any movement in read/write head 34 
until after time T t . Similarly, the post-actuation input applied to the motor does 
5 not cause any movement of read/write head 34 after time T/. However, energy is 
also applied during the transition-time interval, and the read/write head is 
efficiently moved along a trajectory 54 (the desired head position) with a 
minimum energy, as a result of the pre-actuation input, post-actuation input, and 
the transition-interval input. 

10 FIGURE 4 illustrates the functional block diagram that relates to the 

control of the read/write head shown in FIGURE 2. In this diagram, a 
controller 60 produces an output signal that is applied to an actuator motor to 
cause movement of a read/write arm, as indicated in a block 62. The 
actual position of the head is sensed by a position sensor 64, producing a 

15 signal that is subtracted from a desired head position signal (indicated 
by reference numbers 50, 52, and 54 in Figure 3) by a summation block 66. 
The result is an error value, indicating the difference between the desired head 
position and the actual head position; the error value is provided as a 
feedback signal to controller 60. Accordingly, compensation will be made for 

20 the error in the response of the actuator motor and read/write arm in controlling 
the position of the read/write head to achieve the desired head position and 
trajectory, which should result from using the input signals (pre-actuation input, 
post-actuation input, and the transition-interval input) determined by the present 
invention. 

25 FIGURE 5 includes a flow chart 70 showing the logical steps employed in 

carrying out the present invention. At a step 74, the system in which an element is 
to be moved from one position to another is modeled. As noted above, different 
applications of the present invention will involve different kinds of systems and 
different criteria and parameters related to moving an element. Thus, by modeling 

30 the system in step 74, the constraints and other parameters that need to be taken 
into consideration will be specified and then the present invention determines how 
to move the element using either both pre-actuation input and post-actuation 
input, or only one of the pre- and post-actuation inputs, along with the input 
applied during the transition-time interval. 
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A step 76 characterizes the internal dynamics of the system in which 
energy applied either during the pre-actuation input before the start of the 
transition-time interval and/or during the post-actuation input after the end of the 
transition-time interval can be hidden, so that the energy does not cause any 
5 motion of the element immediately before or after the transition-time interval. 
Again, the internal dynamics of the system will vary depending upon the model of 
the system to which the present invention is applied. 

In a step 78, for a given optimization criteria such as achieving a minimum 
energy in moving an element between two positions, or achieving a minimum 

10 transition time interval for moving the element, or a combination of the minimum 
energy and minimum transition-time interval, the logic computes optimal internal 
states at the beginning and end of the output transitions for the desired movement 
of the element. For example, if the element is being employed for scan and seek 
maneuvers, the optimum optimization criteria will likely be to achieve the 

1 5 movement in a minimum time. 

A step 80 computes the optimal inputs, including pre-actuation and 
post-actuation inputs that do not cause any movement other than during the 
transition-time interval. Considerable detail is provided below in regard to a 
generalized approach implemented by the present invention, and more 

20 specifically, in regard to examples in which a read/write head is moved between a 
first position and a second position using a continuous input signal in one case, 
and a discrete input signal in another case. Accordingly, reference to the detailed 
equations that follow and the two examples should provide clarification as to how 
the present invention is implemented. 

25 Problem Formulation 

Assume that a physical system is represented in state-space form by: 

j- t x(t) = Ax(t) + Bu(t) 

,V/e (-00,00) (1) 

y(t) = Cx(t) 

where x(t) e 9?" is the system state, u(t) is the input, and y(t) is the output at time t. 
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Definition 1: The output-transition problem is to find bounded input-state 
trajectories {*(•)>*«/■(•)} that satisfy the system of Eq. (1) and the following two 

conditions: 

The output-transition condition: The output is transferred from an initial 
5 value y to a final value y within the output-transition time interval \t. , t f ] , and is 

maintained constant at the desired value before and after the output transition, i.e., 

JV(') = Z = C f f°rW<;,. 
y r e f {t)=y = Cx forW</, 

The delimiting condition: The state approaches the equilibrium 
configuration as time goes to (plus or minus) infinity, i.e., 
10 x ref x as £ ^ -oo; and x ref x as £ ^ o> (3) 

Definition 2: The optimal (minimum-energy) output-transition problem 
(OOT) is to find bounded input-state trajectories {**(•), x r ef(')} that solve the 

output-transition problem (Definition 1), and minimize the following input-energy 
cost functional, 

15 J ool := )[u{t)] 2 dt (4) 



Determining the OOT Solution 

The first step in solving this problem is to determine the relative degree of a 
system, which is defined as the minimum number of times the output must be 
differentiated so that the input appears explicitly in the output equation. For example, 
20 if the output y(t) in Eq. (1) is differentiated with respect to time, the following result 
is obtained. 

y{t)=Cx{t) 

|*)-Cf*) (5, 
= CAx(t)+CBu(t) 
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If the term CB * 0 , then the system has a relative degree of 1 since the input term 
u(t) explicitly appears in the output equation, i.e., in Eq. (6). If the term C5=0, it is 
necessary to differentiate again. In this case (when CB = 0), the second derivative of 
the output is obtained as: 

5 — y(t) = CAx{t\ (since the term CB = 0) 

at 

= CA 2 x(t)+CABu(t) (6) 

Similarly, if the term CAB * 0 , then the system has a relative degree of 2. If 
the CAB = 0, it will be necessary to continue taking a next higher derivative of the 
10 output, until the input term explicitly appears. The system has a relative degree of r, 
if the term CA r ~ x B in the r th -derivative of the output is not equal to zero and the 
terms, CB, CAB, CA 2 B, CA r ~ 2 B (in the preceding derivatives) are all equal to 
zero, i.e., 

15 = CA r x(t)+ CA r - l Bu(t) (7) 

Next, it is necessary to find the inverse input for the system. The inverse 

input that maintains output tracking, i.e., y(f)= — r can ^ e obtained from 

dt dt r 

Eq. (7), as: 

1 r r1 r 

(8) 



,nvV ' CA r ~ l B 



lLy d {t)-CA'x{t) 



20 where y d (t) is the desired output trajectory. 
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The third step is to choose the transformation matrix that will be used to 
convert the system equations into the output-tracking form. The transformation 
matrix is invertible, i.e., 

C 
CA 



CA r ~ 



(9) 



The transformation matrix T (r) partitions the state x(t) into two components: 
(i) the first r terms are the output and its derivatives up to the order r-1 (denoted by £ 
), and, (ii) the remaining components are called the internal state of the system 
(denoted by 77 ), i.e., 



.?(<) 



it) 



dt 



dt 



Af) 



(0 



L i(0 



(10) 



The transformation matrix (from Eq. (9)) and the inverse input from 
Eq. (8) are applied to the system defined by Eq. (1), as follows. First, multiply the 
transformation matrix from Eq. (9) times the state equation from Eq. (1): 

T *fa) = T * A ^) +T * Bu ® 



d 



dt 



7(0 



Bu(t) 
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Then apply the inverse input from Eq. (8) to the above-transformed state equation: 

T, n Bu inv (t) 



W<)J 



+: 



+71^ — — j — 



-y d (i)-CA r x{t) 



1 



^ . T £n BCA r T £ 

t^at;1 — & 



.*(0J 



+ - 



7*tt 



10 





0 " 




+ 


~v 










A. 



(ii) 



where the matrix has dimension (« - r)x (n - r). (In the preceding expression, r 
is the relative degree and n is the number of states of the system). Since the inverse 
input was chosen as the input to Eq. (8), the result is: 



dt 



(12) 



Rewriting the original system from Eq. (1) in the output-tracking form yields: 



where the vector Y d (t)^= 



(14) 



15 represents the desired values of the output. Eq. (14) is called the "internal 
dynamics" of the system. 
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Next, to decouple the internal dynamics, a transformation matrix T dc is found 
such that: 



A 
o 

0 



0 

A 

0 



0 
0 

A. 



(15) 



where all of the eigenvalues of A s e W'* r ' have real parts less than zero, all 
eigenvalues of A u e 9? r " > "" have real parts greater than zero, and eigenvalues of 
A c e W''' have real parts equal to zero. This matrix transforms the internal state 
7](t) into three states, which are referred to as the strictly stable state, tj s , the 
unstable state, tj u , and the center state, rj c , i.e., 

'*.<<)" 



(16) 



The decoupled transformation matrix, T rfc from Eq. (16) is applied to the 
internal dynamics of Eq. (14) as follows. 



T^B m Y d {t) 



'A 


0 


0" 








0 


A 


0 




+ 




0 


0 


A. 






A. 



£(0 



(17) 



In the above decoupled equations, the eigenvalues of A s s ST**' 5 are the 
minimum-phase zeros of the system of Eq. (1) that lie on the open left half of the 
complex plane, the eigenvalues of e 9? r " xru are the non-minimum phase zeros 
located in the open right half plane, and the eigenvalues of A c e 9T cXrc are the zeros 
that lie on the imaginary axis of the complex plane. 
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In the next step, the transformation matrix T that transforms the original 
system into the decoupled output-tracking form is computed, as follows. 

7_ 0 



T:= 



0 T2 



in 



(18) 



where the matrix I rxr is the rxr identity matrix. The transformation matrix T 
decouples the state in the following coordinates: 



(19) 



In 



the 



preceding 



expression, 



the 



matrices 

e W<»- r \ € W 1 ^, g 9T x(rJ , and e 9T x(rJ are the components of the 
1 0 matrix T l corresponding to each variable %{t\ tj s (t), tj u (t\ and r/ c (t) , respectively. 

Next, the inverse control law expressed in Eq. (8) is rewritten in terms of the 
decoupled internal states and the known output component Y d (t) (using the 
decoupled transformation Tin Eq. (18)) as: 



"mv(0 = 



1 d r CA r T~ x 



CA r ' x B dt 



CA r ~'B 



Vu{t) 



15 



_1 cT_ 

CA r ' x B dt r 



y* (')+ uMt)+U,Tt, (k)+ U u tj u (k)+U e 7j c (k) 



= Usi&)+Uj, m (fi+Uj, e (k)- 



4 ca'- x b\ 



■ at) ' 

w yJt) 



~u,nA*)+u„T,.(k)+VsiAk)+u,r t (k) (20) 

Several parameters must now be computed, including matrices W and 
W p05t by solving the following Lyapunov equations. 



20 



W pre A u+ AlW pre =U T u U u ,m& 
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W pos< A s + 4W post = -U T S U : 



The matrices Hi and H2 are computed as: 



10 



fcl r J r J r,J : = e ^-"V- 
«>J *J -r,l -rj -rj 



(21) 



The known (constrained) components of the boundary states are then 
computed as: 

/:=[r € n? £ i £J (22, 

where |f r £ £ fj = /r r , and '[?' if/ 7/ ^1=^. 
A matrix known as the controllability grammian is defined as: 

G M := ^e^BB'e^'^dr (23) 



15 



20 



The gammian can be directly computed by using numerical integration, or 
alternatively, by solving the differential Lyapunov equation: 

^P{t) = AP(t) + P(t)A T +BB T yt g (t n t f ) 

with a zero initial condition, i.e., where P(t i ) = 0. The controllability gammian can 
be determined using the latter method as G^ t ) = P{t f ). 

The total cost components are computed as: 



A:= 



W, 



post 



w. 



pre J 



b:= 



w n 

preju 



-H T 2 G, 



('<•'/) " 



c := ff[W posl fj s + rfw^ + f 'H' x G- { ; i if) HJ 



(24) 

(25) 
(26) 
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The optimal boundary condition is computed as: 



f A x b , if A is invertible 
lA 1 ^ , otherwise 



(27) 



where A f is the pseudo (generalized) inverse of A satisfying the Moore-Penrose 
conditions, as explained by Ortega, J. in Matrix Theory, Plenum Press, New York, 
1987. 

To compute the optimal output-transition solution, the optimal control input is 
first computed as: 

B*e^>-\ tf) [x (t f )-e^x'(t,)] ift, <t<t f (28) 



U 'oo, (0 = 





where the optimal boundary states are given by: 




10 


»«- T~'k r £ r,7 £] 












The optimal output-transition cost is computed as: 






f oot = ^TVF* - m>* T b + c 


(29) 




Without pre-actuation, the optimal output-transition 


components are 


15 


computed as: 






Mr nl nl £ £ £ rfj 


(30) 




^,:=Kl %u\ «Vl -r] 


(31) 






(32) 




A :=W post + H T 2 G^ t/) H 2 


(33) 


20 


b:=W post n s -H T 2 G- ( l f) Hj 


(34) 
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c := nlW post fj s + f T H[G^ ir) Hj (35) 

The optimal stable internal state is defined by: 

| AT x b , if A is invertible 

£ = ZtC r. ■ (36) 

[A J b , otherwise 

where A 1 " is the pseudo (generalized) inverse of A that satisfies the Moore-Penrose 
5 conditions, referenced above. 

The optimal control input for the output-transition problem without 
pre-actuation is: 

0 if t<t. 

Ko t (t) = \B T e AT ^^ ift, <t <t f (37) 

U 5 e^-''\fi; -ff 5 ] if t>t f 



10 



where the optimal final transition states are computed from: 

*{ t f) = T ~%Z £ 7. V C ]} T 

And, the optimal output-transition without pre-actuation is computed as: 

r oot =^;] T A[rj:]-2[rf:Jb + c (38) 

Exemplary Application of the Present Invention 
for Controlling Disk-Drive Servo System - Continuous Dynamics 

15 In this example, the present invention is applied to a disk-drive servo system. 

A disk drive model is used that has one rigid-body mode and four flexible modes at 
frequencies of 70 Hz, 2200 Hz, 4000 Hz, and 9000 Hz. The input used for 
positioning of the read/write head of the disk drive is continuous in this model. 
The system dynamics are described in a linear state- space form by Eq. (1), where 

20 the matrices A, B, and C, are given by: 



UNTV01 89-1 -2 1/0 1 89AP.doc 



SCV #2838-3676 



-21- 



A = 



o 


*> 


o 


o 


o 


o 


o 


o 


o 


o 


0 




kA 




kA 


KK 


kA 


kA 


kA 


kA 


m 


0 


0 


0 


CO, 


0 


0 


0 


0 


0 


0 


0 


0 


-co x 


-2g l co l 


0 


0 


0 


0 


0 


0 


0 


0 


0 


0 


0 


co 2 


0 


0 


0 


0 


0 


0 


0 


0 


-ta 2 


-2g 2 a> 2 


0 


0 


0 


0 


0 


0 


0 


0 


0 


0 


0 


CO, 


0 


0 


0 


0 


0 


0 


0 


0 




-2g 3 o) 3 


0 


0 


0 


0 


0 


0 


0 


0 


0 


0 


0 


CO, 


0 


0 


0 


0 


0 


0 


0 


0 


-co. 


-2g 4 co, 



B = 



0 
0 
0 
co t 
0 
co 2 
0 
cd 3 
0 



. and 



10 



C = [l 00000000 0] 

and the plant parameters are given in Table 1, which follows below. 

The goal of the optimal output-transition control in this example is to move 
the position of the end-point (denoted by the output y) of the read/write head by 1 unit 
within the prescribed output-transition time (i.e., seek time) of 5 msec by using 
minimum control energy as the objective criterion. During simulations, the output 
transition starts at time = 5 msec and ends at time t f = 10 msec, and the desired 
equilibrium states are chosen to be x = [0 0 0 0 0 0 0 0 0 0], and 
3c = [l 00000000 0]. 
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TABLE 1 



Parameter 


Description 


Value 


Units 


m 


moving mass of actuator 


0.200 


kg 


kt 


force constant 


20.0 


N-Amp' 


k v 


normalization factor 


k t /m 


m-sec^-Amp" 1 


k v 


position measurement gain 


1000 


Volts-m" 1 


kfric 


viscous friction coefficient 


2.51 


... 

N-sec-m 


b, 


first resonance coupling 


-0.00575 




b 2 


first resonance coupling 


0.0000115 


T 

sec" 


b 3 


second resonance coupling 


0.0230 




b 4 


second resonance coupling 


0.00 


sec" 


b 5 


third resonance coupling 


0.8185 


- 


b 6 


third resonance coupling 


0.0 


sec" 1 


b 7 


fourth resonance coupling 


0.1642 




b 8 


fourth resonance coupling 


0.0273 


-i 

sec 


Wi 


resonance: voice coil motor isolator 


2tt70 


rad sec" 1 




resonance: head suspension 


2n2200 


rad sec" 1 


w 3 


resonance: actuator arm carrier 


2x4000 


rad sec" 1 


U>4 


resonance: coil structure 


2ti9000 


rad sec" 1 


fl 


first resonance damping 


0.05 




t2 


second resonance damping 


0.005 




ft 


third resonance damping 


0.05 




& 


fourth resonance damping 


0.005 





10 



The above table lists the parameters for the disk-drive servo model of this 
example. 

The Optimal Output-Transition (OPT) Solution 

Find the relative degree r of the system. The disk-drive servo system Eq. 
(1) has a relative degree r = 3 , since the term CA 2 B = 1.54x 10 9 , and the terms CB 
and CAB are equal to zero. 

Choose the transformation matrix to convert the system equations into the 
output-tracking form. The inverse input that maintains output tracking, i.e., 



",„v(0 := 



1 



CA 2 B 



dt 



■y d (t)-CA 3 x{t) 



(39) 



where y d (t) is the desired output trajectory. 
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Find the transformation matrix for converting to the output-tracking 
form. The transformation matrix 7^ is chosen as, 













c 






















CA 




















CA 












c 




0 


0 


0 


1 


0 


0 


0 


0 


0 


0 


CA 




0 


0 


0 


0 


1 


0 


0 


0 


0 


0 


CA 2 




0 


0 


0 


0 


0 


1 


0 


0 


0 


0 


T 

i . 




0 


0 


0 


0 


0 


0 


1 


0 


0 


0 




0 


0 


0 


0 


0 


0 


0 


1 


0 


0 




0 


0 


0 


0 


0 


0 


0 


0 


1 


0 




0 


0 


0 


0 


0 


0 


0 


0 


0 


1 



(40) 



Transform the system into the output tracking form. Multiply the 
transformation matrix of Eq. (40) times the state equation of Eq. (1), 



dt 



—7(0 
dt 



4(0 
7(0 



+ T a Bu{t). 



Apply the inverse input to the above transformed state equation: 
d 

J*~ I t \ 

4(0 



dt 



4(0 



Jt m . 



7(0 



***** 



'4(0 

.7(0. 



i 



CA 2 B 



—y d (0-CA 3 x(t) 
at 



10 



T fn ATL — & r— & 

* * CA 2 B 



4(0 

.7(0. 



CA 2 B dv 



y d (0 



4* 


o ' 


"£(0" 


+ 


' 0 


.4. 




.7(0, 







rf 3 

A- 



(41) 
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where the matrices A (( , A^ , and 4, are given by: 



4« 


0 


4* 


4, 



0 1 

0 0 
0 0 



0 

1 

0 



0.9600 

0.0000 
-0.0001 

0.0000 
-0.0002 

0.0000 
-0.0004 
0 
0 
0 



0.0765 
0.0000 
0.0001 
0.0000 
0.0002 
0.0000 
0.0004 
0 
0 
0 



0 
0 
0 



0 
0 
0 



0 
0 
0 



-44.1413 1759.2861 



0.0000 . 
-22.6491 
0.0000 
41.1801 
0.0000 
92.6553 



0.0000 
-13823.8265 
0.0000 
0.3294 
0.0000 
0.7411 

0 
0 
0 



-90.5778 
13823.0077 
-2984.9614 

0.0000 
-5175.8752 

0.0000 
-11645.7192 
0 
0 
0 



-62607.6387 

0.0000 

6.4468 

0.0000 
-25121.0198 

0.0000 
26.3732 



-5860.7069 

0.0000 
-184193.6461 
25132.7412 
-337410.8125 

0.0000 
-753519.4614 



12119.9516 
0.0000 

13824.2557 
0.0000 

25135.0103 
0.0000 
5.1055 



-4729.1714 

0.0000 
-83001.8639 

0.0000 
-150912.4799 

56548.6678 
-340118.5664 



Rewrite original system Eq. (1) in the output-tracking form, 

l*-£( t ) = —4 At) 



(42) 



-77(0 = V7(') + [4* B n ]Y d {t) 



(43) 



where the vector Y d (t) := [&(/) r , £^(f) r f = [y d {tf, iy d {t) T ,%y d (t) T , £ %(0 r f • 



10 



The matrix is given by 
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0.9600 
0 

-0.0001 
0 

-0.0002 
0 

-0.0004 



0.0765 
0 

0.0001 
0 

0.0002 
0 



0.0000 
0 

0.0000 
0 

0.0000 
0 



0.0004 0.0000 



Decouple the Internal Dynamics 

Find a decoupled transformation matrix T dc . In this example, the matrix T dc 
is defined by: 

-1.0000 0 0.0004 0.0000 

0.0003 0.0057 -0.0038 -0.7039 

0.0002 0.0000 0.7099 0.0000 

0.0003 0.0057 0.0003 0.0172 



0.0069 
-0.0044 
0.2183 
-0.0147 
0.3979 
-0.0738 
0.8879 



-0.0001 0.0000 -0.0096 -0.0001 
0.0003 0.0057 -0.0007 0.0127 
-0.0000 0.0000 -0.0031 -0.0002 



0.0001 
-0.0340 
0.0041 
-0.1495 
0.0324 
0.7497 
0.0022 



0.0031 
0.0014 
0.1072 
0.0192 
0.2595 
0.0000 
-0.5780 



Apply the decoupled transformation matrix T dc to the internal dynamics Eq. 
(43) as follows, 



d_ 
dt 



*.(0 



d < x 

5 *w 



r?A0 



+ T; e t BY d (t) 



10 



A, 0" 








.° A,. 


.%(0_ 


+ 


A. 



(44) 



15 



Note that the matrix ^ has five eigenvalues with a negative real part, two 
eigenvalues with a positive real part, and no eigenvalue that has a zero real part. 
Thus, the internal state 77 (t) for this disk drive model does not contain the center state 

The matrices A s , \ , B s , and B u are given by 
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A, = 



B. = 



-680700.6605 
0 
0 
0 
0 

0 -0.0006 
0 -0.9600 
0 0.0482 
0 -0.0002 
0 -0.0000 

168.5121 
43598.1504 



0 



0 



-21.99521 440.5294 
-440.5294 -21.99521 



0 
0 

0.0005 
-0.0765 
0.0060 
-0.0000 
0.0000 
-43598.1504 
168.5121 



0 
0 



0.0000 
-0.0000 
0.0002 
0.0000 
0.0000 



B.. = 



0 
0 
0 

-76.1480 
-13939.5985 



0 
0 
0 

13939.5985 
-76.1480 



-0.0000 
-0.0002 



0.0000 
-0.0000 



0.0000 
-0.0000 



Compute the transformation matrix T that transforms the original system into 
the decoupled output-tracking form, 







T:= 


0 T' c \ 






1 


0 


0 


0 


0 


0 


0 


10000 


0 


0 


0 


0 


0 


-125500 


-5750 


11.5000 


23000 


0 


0 


0 


0 


-0.0002 


0.0004 


0.0191 


0 


0 


0 


-1.0000 


-0.0000 


0.0007 


0 


0 


0 


0.0522 


3.9938 


-0.0000 


0 


0 


0 


-0.0002 


0.0002 


1.3995 


0 


0 


0 


0.0000 


-1.3878 


-0.0079 


0 


0 


0 


-0.0000 


-0.0069 


0.0033 


0 


0 


0 


-0.0002 


0.0010 


0.0218 
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0 


0 


0 


0 


0 


0 


0 


0 


818500 


0 


164200 


27300 


-0.0459 


-1.2411 


0.0462 


-0.5623 


-0.0004 


-0.0142 


0.0004 


-0.0012 


142.9389 


0.0007 


28.6750 


4.7676 


0.0175 


0.6708 


-0.0179 


0.0423 


-1.2101 


0.0061 


-0.1787 


-0.0326 


-1.1013 


0.1216 


1.1085 


0.0185 


0.0659 


1.9105 


-0.0668 


-0.8661 



(45) 



The transformation matrix T decouples the state into the following coordinates: 



(46) 



where the matrices <t> 4 , <J> , and <S> , are the components of the matrix 7* 
corresponding to each variable E,(t) , r/ s (t) , and ij u (t) , respectively. 

Rewrite the inverse control law in terms of the decoupled internal states and 
the known output component Y d (t) (using the decoupled transformation T in 
Eq. (45)) as 

"&<0 



10 



1 d 3 CA 3 T- 



CA 2 B dt 3 



CA 2 B 



7,(0 
l*7-(0. 



±x4jy' « + + u u co + u ^u (o 



CA 2 B df 



= U s v s (t) + U u 7j u (t) + [u 4 ^ 



£,(0(42) 
dt 



:=U s rj s (t) + U u ?j u (t) + UY d (t), 



(47) 
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where the components U s , U u , and U y are given by: 

U t =[-10.7523 0.0003 0.0057 -0.0007 0.0119] 
U u =[0.3041 -0.0092] 
£^=[0 -0.7151 0.7560 0.0648]xl0" 



->-8 



Compute the following parameters. 

Compute matrices W pre and W posl by solving the Lyapunov equations 

W pn A u +A[W pre =U T u U u , and 
W post A,+<W pmt =-U]U s . 



which results in 



W„ = 



pre 



w = 

ff post 



0.1374 
0.0005 
0.8492 
0.0000 
0.0009 
0.0001 



0.0005 

0.1374 
0.0000 
0.0037 
-0.0002 
0.0000 



-0.0019 -0.0000 



xlO , and 

0.0009 
-0.0002 
0.0037 
0.0000 
0.0000 



0.0001 
0.0000 
0.0000 
0.0047 
-0.0000 



-0.0019 
-0.0000 
0.0000 
-0.0000 
0.0047 



xl0 _ 
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Compute the matrices H x and H 2 : 



1 nnnn 








n 
yj 


— 1 .uuuu 




o 


0.0001 


-0.0000 


0.0000 


0.0000 


o 


-0.0001 


0 


-0.0022 


-0.0002 


-0.0000 


0.0000 


0 


-0.001 1 


0 


0 


o 


0.0001 


0.0031 


o 


-0.0016 


0 


0 


0 


-0.0340 


0.0014 


0 


0 


0 


0 


o 


0.0041 


0.1072 


o 


0 


0 


0 


o 


-0.1495 


0.0192 


o 


0 


0 


0 


0 


0.0324 


0.2595 


0 


0 


0 


0 


0 


0.7497 


0.0000 


0 


0 


0 


0 


0 


0.0022 


-0.5780 


0 


0 




U.U /O / 


-U.U30Z 


(\ C\AH "\ 
U.UH- / 1 


n c\c\a o 
— U.UU4Z 


— u.uuuz 




0.0000 


-0.0014 


-0.0018 


0.0011 


0.0000 


-0.0000 




0.0001 


-0.0051 


0.7516 


0.4890 


-0.0003 


-0.0000 




-0.0001 


0.0039 


-0.5243 


0.7283 


0.0002 


0.0000 




0 


0.0033 


-0.0002 


-0.0041 


0.0032 


0.4982 




0 


-0.1545 


0.0001 


-0.0000 


-0.5025 


0.0004 




0 


0.0001 


-0.0000 


-0.0000 


-0.0000 


-0.0000 




0 


-0.0007 


0.0000 


-0.0000 


0.0000 


0.0000 




0 


0.0187 


-0.0001 


-0.0014 


0.0002 


-0.0031 




0 


-0.2159 


0.0000 


-0.0000 


0.0008 


0.0000 




o i - r 


1 

7. J 












0 


0 


0 


0 


0 


-0.0010 


-0.0339 


-0.0000 


0.0000 


0.0000 


-0.0000 


-0.0000 


-0.0000 


-0.0007 


-0.0000 


0.0503 


1.0016 


0.0000 


-0.0000 


-0.0001 


-0.0022 


0.0069 


-1.0000 


0.0000 


0.0004 


0.0000 


0.0000 


0.0017 


-0.0044 


0.0003 


0.0057 


-0.0038 


-0.7039 


0.0240 


-0.0010 


0.2183 


-0.0002 


0.0000 


0.7099 


0.0000 


-0.0029 


-0.0759 


-0.0147 


0.0003 


0.0057 


0.0003 


0.0172 


0.0003 


0.0000 


0.3979 


-0.0001 


0.0000 


-0.0096 


0.0001 


-0.0000 


-0.0005 


-0.0738 


0.0003 


0.0057 


-0.0007 


0.0127 


-0.1824 


-0.0005 


0.8879 


-0.0000 


0.0000 


-0.0031 


-0.0002 


-0.0012 


0.1406 



where the components [r ff | | ] := e A(tf ''Y -1 . 
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Compute the constrained components of the boundary states 

= [1 00000000000 of. 

where [f t££ <f = /r',and [T7.7.*J . 

Compute the controllability grammian. In this simulation, the controllability 
grammian is computed using Simpson's rule for numerical integration. 

G (((></) := f^-W'^'rfr 



39971.5562 


1178.2116 


4349.8963 


264.6929 


-3483.5318 


-53.1045 


1178.2116 


48.7268 


146.6033 


72.7196 


69.3019 


-66.5081 


4349.8963 


143.6033 


512.1978 


116.2719 


-226.3305 


-19.7685 


264.6929 


72.7196 


116.2719 


344.4303 


615.1481 


-5.0933 


-3483.5318 


69.3019 


-226.3305 


615.1481 


344887.4335 


0.0436 


-53.1045 


-66.5081 


-19.7685 


-5.0933 


0.0436 


344881.4842 


-169.0146 


60.4713 


0.2002 


440.3320 


1631.6319 


19640.2124 


-25.4815 


-408.5038 


-7.7994 


0.8463 


-10802.1127 


1002.5561 


-1315.8228 


94.8063 


-77.6393 


499.7898 


33.4811 


12174.3012 


-19.2036 


-773.8534 


-4.0528 


-0.0941 


-2971.4024 


37.4577 



-169.0146 


-25.4815 


-1315.8228 


-19.2036 


60.4713 


-408.5038 


94.8063 


-773.8534 


0.2002 


-7.7994 


-77.6393 


-4.0528 


440.3320 


0.8463 


499.7838 


-0.0941 


1631.6319 


-10802.1127 


33.4811 


-2971.4024 


19640.2124 


1002.5561 


12174.3012 


37.4577 


125663.2746 


0.0011 


942.4108 


-13858.9251 


0.001 1 


125663.2611 


31182.6810 


1804.8094 


942.4108 


31182.6810 


2660028.8471 


10.2140 


-13858.9251 


1804.8094 


10.2140 


2660270.3979 
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A := 



Compute the total cost components: 
W_„. 0 



post 

0 



w. 



pre 



+ H 2 G (lt,) H 2 



0.0001 
0.0007 
0.0001 
0.0000 
-0.0000 
0.0000 
0.0000 

w Dre v 

ore * ti 



0.0006 
1.0771 
0.3920 
0.0000 
0.0001 
-0.0000 
0.0002 



0.0001 
0.3920 
0.1915 
0.0000 
0.0000 
-0.0000 
0.0001 



0.0000 
0.0000 
0.0000 
0.0000 
0.0000 
-0.0000 
-0.0000 



-0.0000 
0.0001 
0.0000 
0.0000 
0.0000 

-0.0000 
0.0000 



0.0000 
-0.0000 

0.0000 
-0.0000 
-0.0000 

0.0001 

0.0000 



0.0000 
-0.0002 
0.0001 
-0.0000 
0.0000 
0.0000 
0.0001 



= [0.0001 0.1840 0.0701 0.0000 0.0000 -0.0000 0.0000f 



c := nW. 



post 

= 0.0317 



Compute the optimal boundary condition: 



= AT l b 



= [0.0444 0.1472 0.0649 0.1375 0.4304 0.0004 0.0122] r 

Compute the optimal output-transition solution 

Compute the optimal control input 



M ^(fH5V r <'/-')G ( -;_ v) [x-(^)-^'/-'.v (0] 

C/,^ ( '-'/)[^;--] 



if t < t i 

if t;<t< tj 

if t>t f 



(48) 
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where the optimal boundary states are given by: 



= [l -0.0000 0.0724 -0.1468 -0.3033 0.1073 0.0072 0.0164 0.0025 0.0389] r 



= [0 0.0000 0.0000 0.0000 0.0000 0.0013 0.0002 0.0032 0.0003 -0.007l] r 

Compute the optimal output-transition cost: 
= 9.5091 xl(T 5 

Simulation results: The input signal or optimal output-transition input, 
u oot (t), that is applied to the motor to position the read/write head is shown in 
FIGURE 6, and the resulting output trajectory of the read/write head when the 
optimal input signal is applied is shown in FIGURE 7. As indicated in FIGURE 6, a 
continuous pre-actuation input signal 90 is applied to move the read/write head prior 
to a transition-time interval. In this example, the transition-time interval begins at 
0.005 sec. and ends at 0.01 sec. During the transition-time interval, a continuous 
input signal 92 is applied to move the read/write head. After the transition-time 
interval, a continuous post-actuation input signal 94 is applied. A horizontal line 96 
in FIGURE 7 illustrates that prior to the transition-time interval, the read/write head 
does not move from a first position. During the transition-time interval, the 
read/write head moves to a second position, following a trajectory 98. As indicated 
by a horizontal line 100, the read/write head is also stable at the second position and 
does not move after the end of the transition-time interval. Thus, it will be apparent 
that the read/write head has been efficiently moved between the two positions, while 
achieving the desired optimization criterion. 



Again, the disk-drive model employed in this example consists of one 
rigid-body mode and four flexible modes at the frequencies of 70 Hz, 2200 Hz, 
4000 Hz, and 9000 Hz. The discrete-time dynamics of the model are described in a 
linear state-space form as: 




Exemplary Application of the Present Invention for 
Controlling a Disk Drive Servo Using a Discrete Input System 
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J*(* + l) = Ax(k) + Bu{k) 

\ y {k) = cm 

where the matrices A, B , and C , are given by: 



(49) 



A = 



1 0.6597 
0 0.9992 
0 



-0.0000 
-0.0000 
0.9996 



0 
0 

0.0290 



0 
0 
0 
0 
0 
0 
0 



-0.0290 0.9967 



0 
0 
0 
0 
0 
0 



0 
0 
0 
0 
0 
0 



0.0000 
0.0001 

0 

0 

0.6131 
-0.7873 

0 

0 

0 

0 



0.0000 
0.0001 

0 

0 

0.7873 
0.6052 

0 

0 

0 

0 



0.0014 
0.0033 

0 

0 

0 

0 

-0.0330 
-0.9182 

0 

0 



0.0008 
0.0034 

0 

0 

0 

0 

0.9182 
-0.1249 

0 

0 



0.0001 
-0.0002 

0 

0 

0 

0 

0 

0 

-0.8180 
0.5465 



0.0002 
0.0005 

0 

0 

0 

0 

0 

0; 

-0.5465 
-0.8125 



B = [0.0007 0.0034 0.0004 0.0290 0.3869 0.7873 1.0330 0.9182 1.8180 -0.5465] r , 
and C = [l 00000000 0] 

The goal of the optimal output-transition control in this example is to move 
the position of the end-point (denoted by the output y ) of the read/write head by one 

10 unit within the prescribed output-transition time (i.e., seek time) of 5 msec while 
using a minimum control energy. During simulations of this model, the output 
transition starts at a time t t =5 msec and ends at a time t f =10 msec, and the 

desired equilibrium states are chosen to be: 

x = [0 00000000 0], and x = [l 00000000 0]. 

1 5 The optimal output-transition (OOT) solution 

Find the relative degree r of the system. The discrete-time disk-drive servo 
model Eq. (49) has a relative degree r = 1 , since the term CB = 6.632 x 1 0" 4 . 

Choose the transformation matrix to convert the system equations into the 
output-tracking form. The inverse input that maintains output tracking, i.e., 
20 rt* + l) = x,(* + l),is: 



u inv {k):=^[y d {k + \)-CAx{k)}, 



(50) 



where y d (k) is the desired output trajectory. 
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Find the transformation matrix for converting to the output-tracking 



form. The transformation matrix 7^ is chosen as: 



T -= 



L^J 



0 10 0 

0 0 10 

0 0 0 1 

0 0 0 0 

0 0 0 0 

0 0 0 0 

0 0 0 0 

0 0 0 0 

0 0 0 0 



c 

0 0 0 0 0 0 

0 0 0 0 0 0 

0 0 0 0 0 0 

1 0 0 0 0 0 
0 1 0 0 0 0 
0 0 1 0 0 0 
0 0 0 1 0 0 
0 0 0 0 1 0 
0 0 0 0 0 1 



(51) 



Transform the system into the output tracking form. Multiply the 
transformation matrix T ?t} Eq. (51) with the state equation Eq. (49): 
T^xik + 1) = T 4t) Ax{k) + T^Bu(k) 



V (k) 



Apply the inverse input to the above transformed state equation, 



+ T^Bu inv (k) 



Tj{k) 



10 



f , T £n BCAT~' ^ 

T £n AT7* — & & 

*» CB 



»(*) 



+ ■ 





0 


'£(*)" 


+ 




.4* 


4,. 









(52) 



where the matrices 4^ , ^ , ^ , and Z?^ are given by: 



UNTVOl 89-1 -2 1/01 89AP.doc 



SCV #2838-3676 



-35- 



4* 


0 


4* 


4, 



0 

-5.1564 
-0.6346 
-43.7006 
-583.4237 
-1187.1678 
-1557.6761 
-1384.4479 
-2741.2580 
824.1106 
0 0 



0 

-2.4026 
-0.4187 
-28.8304 
-384.9002 
-783.2063 
-1027.6406 
-913.3573 
-1808.4812 
543.6878 
0 



0 

0.0000 
0.9996 
-0.0284 
0.0073 
0.0149 
0.0195 
0.0173 
0.0343 
-0.0103 
0 



0 

"o 

0.0290 
0.9967 

0 

0 

0 

0 

0 

0 



-0.0040 
-0.0009 
-0.0621 
-0.8289 
-1.6867 
-2.2462 
-2.8852 
-3.8947 
1.1709 



-0.0009 
-0.0005 
-0.0361 
-0.4817 
-0.9802 
-0.3679 
-1.2679 
-2.2633 
0.6804 



-0.0005 
-0.0000 
-0.0026 
-0.0345 
-0.0702 
-0.0921 
-0.0819 
-0.9801 
0.5953 



-0.0007 
-0.0001 
-0.0102 
-0.1367 
-0.2781 
-0.3649 
-0.3243 
-1.1886 
-0.6195 



0 

-0.0001 
-0.0000 



0... 
-0.0000. 
-0.0000. 



-0.0020 -0.0006. 
0.5858 0.7788.. 



-0.8428 
-0.0728 
-0.0647 
-0.1280 
0.0385 
1 

5.1564 
0.6346 
43.7006 
583.4237 
1187.1678 
1557.6761 
1384.4479 
2741.2580 
-824.1106 



0.5879.. 
-0.0227. 
-0.0202. 
-0.0400. 
0.0120.. 



Rewrite the original system of Eq. (49) in the output-tracking form, 
5 £(* + !) = £,(* + !) 



7j(k + l) = A vt) rj(k) + [A 7l{ B n }YAk) 



(53) 



(54) 



10 



wherethe vector ?,(*):= [&(*) r , y d (k + r)J = [y d (k), ^(* + i)] r - 

Decouple the internal dynamics. Find a decoupled transformation matrix 
74 . In this example, the matrix T dc is chosen by: 
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r 

dc 



0.0000 


0.0003 


0.0007 


0.0000 


-0.0000 


0.0000 


-0.0000 


-0.0007 


0.0002 


-0.0000 


0.0000 


-0.0001 


-0.0000 


0.0000 


-0.7081 


0 


-0.0001 


0.0000 


-0.0002 


-0.0018 


0.0088 


-0.0004 


-0.0000 


0.0354 


-0.7052 


-0.0088 


0.0042 


-0.0120 


0.0023 


-0.0944 


0.0039 


0.7035 


-0.0041 


0.0001 


-0.0871 


0.0016 


-0.0084 


-0.0627 


0.2659 


-0.7103 


0 


0.0000 


-0.0001 


-0.2669 


0.1409 


-0.0711 


0.0035 


-0.3360 


-0.0003 


-0.0174 


-0.0041 


0.0001 


-0.3026 


0.0176 


-0.0114 


-0.1654 


0.4431 


0.0079 


-0.0002 


0.0000 


-0.0001 


-0.3996 


0.3109 


0.7766 


0 


-0.7191 


0.0007 


-0.0141 


-0.0040 


0.0001 


-0.7462 


0.1014 


0.0169 


-0.5999 


-0.3067 


-0.0021 


-0.0001 


-0.0000 


0.0000 


0.3363 


-0.9343 



Apply the decoupled transformation matrix T dc to the internal dynamics Eq. (54) as 
follows: 



T;M* + 1) = TJJA,^ (k) + T^B m Y d (k) 



rj s (k + l) 
%{k + 1)J 



?,(*)' 



+ T; c l B nJJ Y d (k) 





0 


>,(*)" 


+ 




0 


A. 






A. 



(55) 



The matrix ^ has seven eigenvalues with a magnitude less than 1, two 

eigenvalues with a magnitude greater than 1, and no eigenvalue having a magnitude 
10 equal to 1. Thus, the internal state tj(k) for this disk drive model does not contain 
the center state ( tj c ). 

Compute the transformation matrix T that transforms the original system into 
the decoupled output-tracking form: 

o t-: 



T:= 



(56) 



15 The transformation matrix T decouples the state into the following 

coordinates: 



x(t) = T-\t{kf T} s (k) T T} u (k) T J 



(57) 
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where the matrices O f , , and <D^ , are the components of the matrix T' 1 
corresponding to each variable %(k) , rj s (k) , and tj u {k) , respectively. 

Rewrite the inverse control law in terms of the decoupled internal states and 
the known output component Y d (k) (using the decoupled transformation T in 
Eq. (56)) as 



:—y d (k + l) + U e 4(k) + U s tj s (k) + U u rj u (k) + U c tj c (k) 



= U,r f ,(k) + U H i Jm (k) + U e Ti e (k) + 



4 CB. 



6(0 



■= U s rj s (k) + U u rj u (k) + U c rj c (k) + U y Y d (k) 

10 where the components U s , U u , and U y are given by 

U M =[0.0541 0.0996 -0.3527 0.0061 -0.0107 -0.0040 -0.0000] 

U u =[1.7923 -0.2935] 

t/ y =[-1.5078 1.5078]xl0 3 . 



(58) 



15 



Compute the following parameters: 

Compute matrices W and W pos , by solving the discrete-time algebraic 
Lyapunov equations: 

(4") r »W -W PK +W) T U T U U U ^ =0, and 
AlW post A s -W posl+ UjU s =0. 



Compute the matrices H , and H 2 : 



rjr |r_ y= A kf ' ki ~ r+X T~ X 



M^i°*i- r «i- r *] 
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Compute the constrained components of the boundary states: 

= [1 00000000000 of 

where [i r f££>fl [T7Xn$ = 7** . 

Compute the controllability grammian. In this simulation, the controllability 
grammian is computed by using Simpson's rule for numerical integration: 







k=k—r+\ 


- I 55 r (^ r )* / "*" 1 




2.5612 


0.0763 


0.2820 


0.0214 -0.1776 


-0.1476 


0.0763 


0.0032 


0.0094 


0.0049 


0.0049 


-0.0068 


0.2820 


0.0094 


0.0335 


0.0079 


-0.0115 


-0.0108 


0.0214 


0.0049 


0.0079 


0.0225 


0.0380 


0.0070 


-0.1776 


0.0049 


-0.0115 


0.0380 


21.2001 


0.1169 


-0.1476 


-0.0068 


-0.0108 


0.0070 


0.1169 


20.9566 


-0.0084 


0.0034 


0.0000 


0.0290 


0.1001 


1.2197 


-0.0021 


-0.0212 


-0.0004 


0.0001 


-0.5463 


0.0580 


0.0723 


0.0026 


0.0050 


0.0253 


-0.0945 


1.1389 


-0.0245 


-0.0136 


-0.0015 


0.0012 


0.2033 


-0.0296 


-0.0084 


-0.0021 


0.0723 


-0.0245" 






0.0034 


-0.0212 


0.0026 


-0.0136 






0.0000 


-0.0004 


0.0050 


-0.0015 






0.0290 


0.0001 


0.0253 


0.0012 






0.1001 


-0.5463 


-0.0945 


0.2033 






1.2197 


0.0580 


1.1389 


-0.0296 






6.5662 


0.2170 


0.1589 


0.7983 






0.2170 


6.5300 


2.4263 


-0.1694 






0.1589 


2.4263 


46.1930 


-1.7887 






0.7983 


-0.1694 


-1.7887 


45.9564 
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Compute the total cost components: 





A:= 


o 

. o w pre 






0.0998 


0.0055 


-0.0394 


0.0003 


-0.0006 


0.0141 


0 0055 


0 0968 


-0 0521 


0.0024 


-0.0007 


0 4983 


-0.0394 


-0.0521 


0.2339 


-0.0141 


0.0001 


-3.2064 


0.0003 


0.0024 


-0.0141 


0.0321 


0.0002 


-0.0909 


-0.0006 


-0.0007 


0.0001 


0.0002 


0.0315 


0.6124 


0.0141 


0.4983 


-3.2064 


-0.0909 


0.6124 


1957.4165 


-0.2287 


-1.8897 


11.7127 


-0.1716 


-1.5111 


-3594.9956 


-0.0026 


-0.0016 


-0.0005 


-0.0072 


-0.0006 


5.1638 


-0.0010 


0.0028 


0.0036 


0.0030 


0.0013 


-2.3374 



-0.2287 


-0.0026 


-0.0010 


-1.8897 


-0.0016 


0.0028 


11.7127 


-0.0005 


0.0036 


-0.1716 


-0.0072 


0.0030 


-1.5111 


-0.0006 


0.0013 


-3594.9956 


5.1638 


-2.3374 


8339.7962 


-7.9194 


3.5656 


-7.9194 


0.1601 


-0.1372 


3.5656 


-0.1372 


0.9741 


pre_!_u _ 





= [-0.0501 -0.4517 2.8084 -0.0267 -0.3834 -935.3361... 
2071.0618 -2.2227 1.0035] 7 ". 

= 520.2577 
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Compute the optimal boundary condition: 



= A- 1 b 



= [0.1517 0.0638 0.4988 0.0483 -0.4536 -0.1043 0.2021 -0.5494 -0.0386] 7 



Compute the optimal output-transition solution. 

Compute the optimal control input: 



if k<k,-r 



B T {A T ) k '- k - i G^ k/) [x'(k f )-A*'- K '- r+l x(k i )l if k i -r<k<k f (59) 

uA- ,f W s -7i) if k>k f 



4 */-*#~r+l 



where the optimal boundary states are given by: 



10 



x (k,) = T 



-1 



-[0.0511 0,0010 0.0034 -0.0026 -0.0380 0.0992 -0.0004 0.0004 -0.0843 0.0655] 7 



-T J—T—T 
* 71 s \ \ 



= [l 0.0004 0.0754 -0.1417 -0.3460 0.0144 -0.1728 0.2101 -0.2256 -0.1956] 7 



Compute the optimal output-transition cost: 

r oot =vj/* r Avp* ~m>* T b+c 

= 1.4067 



Simulation results. The discrete optimal output-transition input signal, 
1 5 u *oot (*) > which is applied to the motor that positions the read/write head is shown in 
FIGURE 8. The output trajectory of the read/write head when the optimal input of 
FIGURE 8 is applied to the motor is illustrated in FIGURE 9. As shown in 
FIGURE 8, a discrete pre-actuation input signal 1 10 is applied to move the read/write 
head prior to a transition-time interval (again extending from 0.005 sec. to 0.01 sec in 
20 this example). During the transition-time interval, a discrete input signal 112 is 
applied to move the read/write head. After the transition-time interval, a discrete 
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post-actuation input signal 114 is applied. A horizontal line 116 in FIGURE 9 
illustrates that prior to the transition-time interval, the read/write head does not move 
from a first position. During the transition-time interval, the read/write head follows 
a trajectory 1 18 as it moves to a second position, indicated by a horizontal line 120. 
5 At the second position, the read/write head is also stable and does not move. Thus, a 
discrete input comprising a plurality of pulses, including both a pre-actuation input 
and a post-actuation input is employed, and the read/write head is again efficiently 
moved between the two positions, while achieving the desired optimization criterion. 
Although the present invention has been described in connection with the 
10 preferred form of practicing it, those of ordinary skill in the art will understand that 
many modifications can be made thereto within the scope of the claims that follow. 
Accordingly, it is not intended that the scope of the invention in any way be limited 
by the above description, but instead be determined entirely by reference to the claims 
that follow. 
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